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(57) ABSTRACT 

A robotic system includes a robotic mechanism responsive to 
velocity control signals, and a permissible workspace defined 
by a convex -polygon boundary. A host machine determines a 
position of a reference point on the mechanism with respect to 
the boundary, and includes an algorithm for enforcing the 
boundary by automatically shaping the velocity control sig- 
nals as a function of the position, thereby providing smooth 
and unperturbed operation of the mechanism along the edges 
and comers of the boundary. The algorithm is suited for 
application with higher speeds and/or external forces. A host 
machine includes an algorithm for enforcing the boundary by 
shaping the velocity control signals as a function of the ref- 
erence point position, and a hardware module for executing 
the algorithm. A method for enforcing the convex -polygon 
boundary is also provided that shapes a velocity control signal 
via a host machine as a function of the reference point posi- 
tion. 

14 Claims, 3 Drawing Sheets 
















U.S. Patent 


Mar. 18, 2014 


Sheet 3 of 3 


US 8,676,382 B2 







52 



US 8,676,382 B2 


1 

APPLYING WORKSPACE LIMITATIONS IN A 
VELOCITY-CONTROLLED ROBOTIC 
MECHANISM 

STATEMENT REGARDING FEDERALLY 5 

SPONSORED RESEARCH OR DEVELOPMENT 

This invention was made with government support under 
NASA Space Act Agreement number SAA-AT-07-003. The 
government may have certain ri gilts in the invention. 10 

TECHNICAL FIELD 

The present invention relates to the control of a wrist 
assembly or other robotic mechanism within a robotic sys- 15 
tern. 

BACKGROUND OF THE INVENTION 

Dexterous robots are able to precisely grasp and manipu- 20 
late objects using a series of linkages, which in turn are 
interconnected via one or more motor-driven robotic joints. 
End-effectors are the particular linkages used to perform a 
given task at hand, such as grasping and maneuvering a work 
tool or other object. Humanoid robots are a particular type of 25 
dexterous robot having an approximately human structure, 
e.g., a full body, torso, hand(s), and/or another appendage(s). 
The structural and control complexity of any robotic system is 
largely dependent upon commanded work tasks, and there- 
fore dexterous robots present a substantially greater control 30 
challenge relative to the control of conventional robots. 

Dexterous robots may include one or more end effectors, 
such as a robotic wrist assembly having an open wrist joint, 
the proper control of which can enable a more precise han- 
dling of a grasped object. An open wrist joint results in wrist 35 
degrees of freedom that are actuated by indirect drives in a 
closed-chain mechanism. The mapping between the actuator 
space of any velocity-controlled wrist actuators and the joint 
space itself is thus coupled and nonlinear, as is understood in 
the art. Therefore, such a wrist joint can end up having an 40 
irregularly-shaped permissible workspace. Stable operation 
of a robotic mechanism operating within such a workspace is 
paramount to the optimal functioning of the robotic system. 

SUMMARY OF THE INVENTION 45 

Accordingly, a software-based method is provided herein 
for enforcing a complex-polygon workspace boundary of a 
velocity-controlled robotic mechanism, e.g., a robotic wrist 
assembly that is responsive to velocity control signals. The 50 
present method is applicable to any coupled and complex 
workspace wherein the degrees of freedom (DOF) of the 
robotic mechanism are actuated by coupled and non-direct 
joint actuators. Due to the coupled mapping between the 
DOFs and the joint actuators, the boundaries of the work- 55 
space are implemented in software rather than as simple hard 
stops. Although a closed-chain wrist mechanism is used 
herein for illustrative purposes, the present method may also 
be applied to the operational space of any serial chain 
manipulator. 60 

The complex workspace of the robotic mechanism is 
defined herein by a convex -polygon, i.e., a convex set defined 
by n corners in real vector space, as is well understood in the 
mathematical arts. A convex-polygon workspace may pro- 
vide the robotic mechanism with a greatly increased range of 65 
motion of relative to a conventional rectangular workspace. 
Additionally, the method eliminates software-induced stick- 


2 

ing, slipping, and chattering along the boundary, i.e., along 
the edges and in the comers of the workspace. 

In particular, a robotic system is provided herein that 
includes a robotic mechanism. Hie robotic mechanism is 
responsive to velocity control signals, and lias a permissible 
workspace, i.e., a workspace that is simultaneously depen- 
dent on multiple joints of the mechanism. Within the system, 
a host machine determines a position of a reference point on 
the robotic mechanism with respect to the boundary. The host 
machine includes an algorithm for enforcing the boundary by 
automatically shaping the velocity control signals as a func- 
tion of the reference point position with respect to the bound- 
ary, thereby providing a smooth and unperturbed operation of 
the robotic mechanism along the edges and comers of the 
boundary. 

A host machine is also provided that is adapted for use 
within a robotic system. As noted above, the system includes 
a robotic mechanism that is responsive to velocity control 
signals. The host machine includes a hardware module that is 
electrically connected to the robotic mechanism, and that 
determines a position of reference point on the robotic 
mechanism with respect to the complex-polygon boundary, 
e.g., using joint sensors or other sensors. The host machine 
includes an algorithm for enforcing the boundary. Execution 
of the algorithm by the hardware module automatically 
shapes the velocity control signals as a function of the refer- 
ence point position with respect to the boundary, thereby 
providing a smooth and unperturbed operation of the robotic 
mechanism along the edges and within the corners of the 
boundary. Transitional buffers applied near the edges and 
corners of the boundary ensure stable, non-chattering perfor- 
mance, especially with high speeds and/or external forces. 

A method is also provided for enforcing the convex -poly- 
gon boundary noted above. The method includes determining 
whether the reference point on the mechanism lies within the 
boundary, and automatically shaping the velocity control sig- 
nals) as a function of the distance of the reference point 
relative to the boundary, thereby ensuring a smooth and 
unperturbed operation of the robotic mechanism along the 
edges and corners of the boundary. 

The above features and advantages and other features and 
advantages of the present invention are readily apparent from 
the following detailed description of the best modes for car- 
rying out the invention when taken in connection with the 
accompanying drawings. 

BRIEF DESCRIPTION OF THE DRAWINGS 

FIG. 1 is a schematic perspective view illustration of a 
robotic system controllable in accordance with the present 
invention; 

FIG. 2 is a perspective top view illustration of a lower 
robotic ann assembly of the robotic system shown in FIG. 1; 

FIG. 3 is a schematic illustration of a sample convex- 
polygon workspace for a wrist assembly of the lower robotic 
arm assembly shown in FIG. 2; 

FIG. 4 is a flow chart describing a method for applying 
workspace limitations in the wrist assembly shown in FIG. 2; 

FIG. 5 is a schematic illustration of a convex-polygon 
usable for enforcing workspace limits on the wrist assembly 
shown in FIG. 2; 

FIG. 6 is another schematic illustration of a convex -poly- 
gon usable for enforcing workspace limits on the wrist assem- 
bly shown in FIG. 2; 

FIG. 7 is a schematic illustration of a convex-polygon 
workspace used to explain velocity distribution for the wrist 
assembly shown in FIG. 2; 



US 8,676,382 B2 


3 

FIG. 8 is a unit circle showing velocity distribution at a 
corner of the convex-polygon workspace of FIG. 7; and 

FIG. 9 is a schematic illustration of a software spring- 
enforced convex-polygon workspace of the wrist assembly 
shown in FIG. 2. 

DETAILED DESCRIPTION 

With reference to the drawings, wherein like reference 
numbers refer to the same or similar components throughout 
the several views, and beginning with FIG. 1 , a robotic system 
10 is adapted to perform one or more dexterous and auto- 
mated tasks. The robotic system 10 is configured with inde- 
pendently and/or interdependently-moveable robotic joints, 
such as but not limited to a shoulder joint, the position of 
which is generally indicated by arrow A. Robotic system 10 
may also include an elbow joint (arrow B), a wrist joint (arrow 
C), a neckjoint (arrow D), a waist joint (arrow E), and various 
finger/thumb joints (arrow F). 

Additionally, the robotic system 10 includes a lower arm 
assembly 12 having one or more anthropomorphic and dex- 
terous hands 14, each moveable via a wrist assembly 16. Each 
hand 14 may includes an opposable thumb and one or more 
fingers as shown, which when operated together are capable 
of grasping an object 20 in the same hand, or in a cooperative 
grasp between different hands. The wrist assembly 16 forms 
a closed-chain robotic mechanism that may be controlled via 
the method or algorithm set forth herein. While control of 
wrist assembly 16 is described below, the present method 
may also be applied to control other robotic mechanisms 
within the robotic system 10, as will be understood by those 
of ordinary skill in the art. 

A host machine (HOST) 18 is adapted, via execution of a 
control algorithm 100, for enforcing certain defined work- 
space limits on the wrist assembly 16 by shaping and applying 
velocity control signals (arrow 11) as set forth below. Such 
enforcement provides an irregularly-shaped or convex -poly- 
gon workspace, and a smooth, stable operation of the wrist 
assembly 16 along the edge segments or edges and corners of 
its boundary, as described extensively below with reference to 
FIGS. 3-9. 

Host machine 18 includes a suitably configured hardware 
module 22 that is electrically connected to the mechanism 
being controlled, e.g., the wrist assembly 16. Hardware mod- 
ule 22 may include a digital computer(s) or data processing 
device(s) having one or more microprocessors or central pro- 
cessing units (CPU), sufficient read only memory (ROM), 
and sufficient random access memory (RAM). Hardware 
module 22 may also include erasable electrically-program- 
mable read only memory (EEPROM), a high-speed clock, 
analog-to-digital (A/D) circuitry, digital-to-analog (D/A) cir- 
cuitry, and required input/output (I/O) circuitry and devices, 
as well as appropriate signal conditioning and buffer electron- 
ics. Individual control algorithms resident in hardware mod- 
ule 22 or readily accessible thereby, including algorithm 100 
as described below with reference to FIG. 4, may be auto- 
matically executed by the module as needed to provide the 
required control functionality. 

Referring to FIG. 2, the lower arm assembly 12 is shown in 
more detail to include the wrist assembly 16. As noted above, 
the wrist assembly 16 is a robotic mechanism suitable for 
control per the present method, and therefore the wrist assem- 
bly of FIG. 2 will be used hereafter for illustrative purposes. 
Movement of wrist assembly 16 is provided via one or more 
actuators 24. In one embodiment, the actuators 24, e.g., push- 
pull linear actuators such as tension and/or force-generating 
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joint motors, may be embedded within the structure of the 
lower arm assembly 12 as shown. 

Wrist assembly 16 is thus moveable in different directions, 
and therefore is moveable along different pitch (8) and yaw 
5 (if) axes. The position of the wrist assembly 16 can be deter- 
mined via sensors 15, with the measurements from the sen- 
sors transmitted to the host machine 18 of FIG. 1. Sensors 15 
may include joint sensors adapted for determining joint 
angles along the pitch and yaw axes, and/or other devices 
10 suitable for determining the position of a reference point on 
the wrist assembly 1 6 as set forth below, and for relaying the 
position information to the host machine 18 of FIG. 1. The 
wrist assembly 16 may be moved via the actuators 24 via 
15 indirect drives in a closed-chain mechanism, with required 
mapping between the actuator spaces and the joint spaces 
thus coupled and nonlinear, i.e., the mapping between the 
joint and actuator degrees-of-freedom are coupled such that 
the velocity of a joint is a function of the velocity of its 
20 multiple actuators. Because of this, the wrist assembly 16 has 
an irregularly-shaped or convex-polygon boundary of a per- 
missible workspace, as will now be explained with reference 
to FIG. 3. 

Referring to FIG. 3, a permissible workspace 30 for the 
25 wrist assembly 16 shown in FIG. 2 may be defined by a 
convex-polygon boundary 40, a term that is understood and 
the art and described above. Workspace 30 may be plotted on 
the pitch (9) and yaw (<j>) axes as shown. The workspace 30 
may be physically limited by many different factors. Shown 
30 schematically in FIG. 3, workspace 30 may be bounded in 
part by close proximity of delicate wires (feature 32), math- 
ematical singularities (feature 34) such as pitch limits, and 
hard stops (feature 36), e.g., contact with a casing (not shown) 
for the lower arm assembly 12 of FIG. 2. Other variables, 
35 whether physical or virtual, may likewise define and/or limit 
the workspace 30. 

The joint limits on a conventional robot are typically 
defined independently, which in FIG. 3 would appear as an 
axis-aligned rectangle. The conventional workspace may 
40 therefore be greatly expanded into a convex-polygon, for 
example a polygon as shown in FIG. 3, to thereby optimize 
performance of the wrist assembly 16. However, the 
expanded complex nature of the workspace results in a 
greatly increased level of required control complexity. 

45 Referring to FIG. 4, the algorithm 100 of the present inven- 
tion automatically allows for velocity -based control to occur 
within an irregularly-shaped workspace, e.g., the workspace 
30 noted above, to provide a smooth, stable, and unperturbed 
operation of the controlled robotic mechanism along the 
50 boundary, e.g., the boundary 40 shown in FIG. 3. Algorithm 
100 therefore has two key features : ( 1 ) convex -polygon man- 
agement techniques, and (2) a velocity distribution map or 
logic, each of which are explained further below. While two 
degrees of freedom (DOF) are used for conceptual illustration 
55 throughout the present work, three or more DOF may also be 
used as understood by those of ordinary skill in the art. 

Execution of algorithm 100 automatically identifies the 
boundary 40 of workspace 30 using an arc segment test, 
determines if a reference point (P) in the arc of the mechanism 
60 lies within the workspace 30, and shapes the velocity control 
signals 11 of FIG. 1 as a function of the distance of the 
reference point (P) from the boundary 40. In one embodi- 
ment, the host machine 18 of FIG. 1 shapes and applies an 
output velocity via signals 11 to the mechanism in one man- 
65 ner if the reference point (P) lies outside of the workspace 30, 
and applies the output velocity in another manner if the ref- 
erence point (P) lies inside the workspace. 
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Referring briefly to FIG. 5, the workspace 30 may be 
defined by its multiple comer points, which are progressively 
numbered 1-5 in the example shown. The workspace 30 can 
be divided into different adjacent arc segments 50 (see FIG. 

6), as defined by the lines drawn radially-outward from cen- 5 
troid 52. The identification of the particular arc segment 50 in 
which reference point (P) lies plays an important function in 
the subsequent velocity shaping logic set forth below. 

Referring again to FIG. 4, algorithm 100 begins with step 
102, wherein a desired velocity is input into the host machine to 
18 shown in FIG. 1 as velocity control signals 11, and the 
current position of the wrist assembly 16 is determined, e.g., 
using sensors 15 or other suitable means. The current position 
is the reference point (P) noted above. The algorithm 100 then 
proceeds to step 104. 15 

At step 104, the arc segment 50 of wrist assembly 16 is 
identified. Referring to FIG. 6, the angles (4) L -c() 5 ) subtending 
the vectors from a reference point (P) on the mechanism to 
each other are shown. The algorithm 100 determines within 
which particular arc segment 50 the reference point (P) lies. 
The answer determines which line segment of boundary 40, 20 
and which corresponding nonnal vector, to use for the veloc- 
ity shaping steps described below. 

0, may be considered the angle between r CP and r ci , as 
shown in FIG. 5, with C referring to the centroid 52. To test if 
a reference point (P) lies in the segment “12” of FIG. 5, for 25 
example, the following two conditions must be satisfied: 


(rcpXr C i)-krcpXr C 2) k <0 
9i +02 <7T 


30 


where k represents the unit vector out of the plane. The first 
condition ensures that reference point (P) lies between either 
of the two corner vectors, r cl and r^, or the negatives of the 35 
two corner vectors, -r ci and -r C2 . The second condition 
eliminates the latter possibility. While inside the envelope of 
workspace 30 one might simply find the closest line segment, 
outside of the envelope doing so might identify an incorrect 
border line. For illustrative purposes it is assumed herein that 40 
reference point (P) lies in the segment ‘12’, and that it lies 
closer to the right edge than the left, i.e., 0 2 <0 1 . Accordingly, 
n : is the primary normal and n 2 is the secondary normal as 
shown in FIG. 5. In the same sense, dj refers to the distance 
from reference point (P) to a primary boundary, and d 2 is the 45 
distance to a secondary boundary, as set forth below. 

Referring again to FIG. 4, at step 106 the host machine 18 
of FIG. 1 determines whether reference point (P) lies within 
the envelope of boundary 40. If so, the algorithm 100 pro- 
ceeds to step 108. If reference point (P) does not lie within the 5Q 
boundaries 40, the algorithm 100 proceeds to step 107. 

Step 106 may be accomplished in two ways. First, consider 
the vectors drawn from reference point (P) to each other, r Pj , 
as shown in FIG. 6. cp, represents the angle between two 
consecutive vectors. Angles between vectors may be defined 
in the range [0, it]. Reference point (P) will lie in the envelope 55 
of the workspace 30 if and only if: 


be derived with respect to the centroid 52, since the centroid 
is guaranteed to lie inside the workspace 30. Thus: 


fie -''m +d \ 
' r ic r ic I 


n.j 



Note that the count (i+1) rolls over to 1 when i=n. Accord- 
ingly, reference point (P) lies within the envelope if and only 


if: 


rip-nfO.Vi. 

At step 107, the host machine 18, having determined the 
correct arc at step 104 and that reference point (P) lies outside 
of the boundary of workspace 30 at step 106, projects and 
scales or shapes the velocity control signals 11, and then 
proceeds to step 109. Velocity control signals 11 for the wrist 
assembly 16 need to be automatically shaped so as to enforce 
the boundaries 40 in software. As will be understood by those 
of ordinary skill in the art, due to the coupled mapping 
between the DOFs and the actuators 24 of the wrist assembly 
16 of FIG. 2, the boundary 40 cannot be implemented in 
hardware using simple joint limits. 

Referring to FIG. 7, a snapshot is shown of allowable 
velocity distribution patterns 56, 58 with respect to the 
boundary 40. These distribution patterns 56, 58 reflect two 
key considerations. First, when the reference point (P) lies 
outside of the workspace 30, any normal component pointing 
away from the boundary 40 should be automatically zeroed 
by the host machine 18. This step keeps the reference point 
(P) from moving away from the boundary 40 while still 
permitting tangential velocities along the boundary. These 
tangential velocities are important to allow the controlled 
robotic mechanism, e.g., the wrist assembly 16, to move 
freely without software-induced stick and/or slip, and to 
allow the reference point (P) to find the point on the boundary 
40 that is closest to a desired point. Second, any transitions 
from one region of allowable velocities to another should be 
continuous and gradual in order to avoid instabilities and 
chatter. These transitions occur at both the edges and the 
corners of the boundary 40, as shown in FIG. 7. 

Therefore, if the reference point (P) is determined to lie 
outside of the envelope of boundary 40, any velocity compo- 
nent pointing away from the boundary is automatically 
zeroed. This results in the semi-circular velocity distribution 
patterns 56 as shown in FIG. 7. In addition, a velocity com- 
ponent pointing back to the boundary 40 and proportional to 
the distance from the boundary is superimposed. 

At step 1 08, and as shown in FIG. 7, when operating within 
the workspace 30 the algorithm 100 of FIG. 4 determines 
whether reference point (P) lies within a predetermined buffer 
55, which is defined as the area between the boundary 40 and 
a predetermined inner boundary 40A. If this buffer 55 is 
defined by a distance {d max ), the following equations may be 
used: 


Yj = 2n - 60 

i=l 


The second way, which is scalable to higher DOFs, 
involves looking at the normal vectors for each line segment 
of the boundary 40. Let n, represent the unit vector in the 65 
normal direction for segment i. This normal must be defined 
pointing into the workspace 30. The nonnal vectors will thus 


‘ d max 

( v - <5i(v-«i)«i, (v-rii < 0) A (d\ < d max ) 

Vo =\ 

{ v, else 

If the reference point (P) is outside of the buffer 55, the 
algorithm 100 proceeds to step 112, otherwise proceeding to 
step 110 when the reference point (P) is within the buffer. 
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At step 109, the host machine 18 determines whether the 
reference point (P) is within buffer 55 of FIG. 7, and proceeds 
to step 111 if it is. Otherwise, the algorithm 100 proceeds to 
step 113. 

At step 110, having determined at step 108 that reference 5 
point (P) lies within the buffer 55, the host machine 18 of FIG. 

1 either blends the normal component along the boundary 40, 
or it accounts for blended transitions at each corner of the 
workspace 30, depending on where the reference point (P) is 
located. That is, when reference point (P) is within the buffer to 
55 and the velocity is pointed towards the boundary 40, the 
normal component of the velocity is gradually dropped to 
zero to provide a continuous transition from inside to outside. 

When operating in a comer of the workspace 30, as a point 
inside the envelope approaches the primary boundary or 15 
boundary 40, any normal component of velocity is scaled 
down by the host machine 18. That is, the component of a 
desired velocity pointing outwards in the normal direction 
with respect to a neighboring segment of the boundary 40 is 
gradually decreased. In addition, as the point enters a comer 20 
and approaches inner boundary 40A, the tangential velocity is 
also scaled down. Using a two-stage projection, the first stage 
scales down the normal component with respect to the inner 
boundary 40A. The second projection scales down the normal 
component with respect to the primary boundary, i .e. , bound- 25 
ary 40. The new rule for the points inside the envelope at the 
corners is: 

v , = iv-d 2 (vn 2 )n 2 , (v -«2 <0) a (4 2 <d mclx ) 

[ v, else 

f / -di(v' -ni)ni, <0) A (di <d max ) 

v o = \ , 

( v , else 

35 

The algorithm 100 then proceeds to step 112. 

At step 111, the host machine 18 projects and scales the 
velocity control signals 11, and proceeds to step 113. 

At step 112, the host machine 20 maintains the desired 40 
velocity, i.e., it outputs a velocity control signals 11 with no 
changes. The algorithm 100 is finished. 

At step 113, a virtual or software-based “spring” is added 
that is proportional to the distance of the reference point (P) 
from the boundary 40, i.e., f=kAx. The wrist assembly 16 is 45 
forced back to the boundary 40 in software, and velocity is 
scaled to zero at the boundaries. 

Referring to FIG. 8, in understanding the transition needed 
for a virtual spring component, consider the vector from a 
corner to reference point (P), or i 2P , and project it onto a unit 50 
circle 60. An ideal solution would apply the spring definition, 
v^kdjnj, to all cases except where r 2P lies in region I. In 
region I, the spring would be based on the vector to the comer: 
v^-kr^p. k is the proportional gain. The result is a continuous 
and smooth spring value as reference point (P) moves from 55 
one segment to the next. Unfortunately, trying to determine 
the relative location of reference point (P) to the unit circle 60 
would introduce a non-trivial amount of extra computation. 
The location of the unit circle 60 is independent of the results 
from the arc segment test noted above, and requires several 60 
new angle computations. 

Alternately, an approximate solution may be determined 
that performs satisfactorily and that utilizes the previously 
computed data. This solution considers the corner angle, 0 2 , 
and blends the two adjacent normals to provide a continuous 65 
change in direction from one arc segment to the next. The new 
rule for the spring component is as follows: 


kdi I I 1 — 02^1 + 0 2 n 2 ), 0 2 < Omax 
kdyfif , else 

Virtual springs 70, i.e., software generated to systemati- 
cally enforce the rules set forth above, are thus employed by 
the host machine 18 to enforce the boundary 40, with the 
velocity component v J =kd 1 n 1 . In particular, the spring com- 
ponent provided by virtual springs 70 is needed for back- 
drivable systems, as that term is understood in the art. Let v 
refer to the initially desired velocity, and v 0 to the output 
commanded after velocity shaping. The following rule 
defines velocity inside and outside the envelope: 


. V - (v-fli)fli + V$, V-«1<0 
v’ = < 

lv + vs> else 

v' -di{v' -ni)ni, (v'-ni <0) A (di <d max ) 
v' , else 

This rule provides a continuous transition to the sides and 
corners of the workspace 30, however, the transition across 
the arc segment may be discontinuous. As the reference point 
(P) crosses from one arc segment to the next, the primary and 
secondary borders swap places. If the two are orthogonal, 
iij n 2 =0, the transition will be continuous. Otherwise, a minor 
discontinuity will exist according to the degree of non-or- 
thogonality. 

Therefore, at step 115, the algorithm 1 00 outputs the veloc- 
ity control signals 1 1 to the wrist assembly 16. The algorithm 
100 is finished. 

While the best modes for carrying out the invention have 
been described in detail, those familiar with the art to which 
this invention relates will recognize various alternative 
designs and embodiments for practicing the invention within 
the scope of the appended claims. 

The invention claimed is: 

1. A robotic system comprising: 

a robotic mechanism responsive to velocity control signals, 
wherein the robotic mechanism has at least two degrees 
of freedom and a permissible workspace defined by 
respective axes of the robotic mechanism; and 

a host machine configured to control an operation of the 
robotic mechanism, and to apply a convex-polygon 
boundary to the permissible workspace, wherein the 
boundary has a centroid and is defined by multiple edges 
and comer points, and includes a buffer that is sur- 
rounded by the multiple edges, wherein the host 
machine includes an algorithm, the execution of which 
by the host machine causes the host machine to: 
determine a position of a reference point on the robotic 
mechanism with respect to the boundary; 
divide the workspace into a plurality of arc segments 
defined by line segments drawn radially-outward 
from the centroid to the corner points; and 
enforce the boundary by automatically shaping the 
velocity control signals as a function of the position of 
the reference point with respect to the buffer, the 
comer points, and the line segments using an arc 
segment test, thereby providing a smooth and unper- 
turbed operation of the robotic mechanism along the 
edges and corners of the boundary. 
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2. The robotic system of claim 1, wherein the robotic 
mechanism is a robotic wrist assembly having an open wrist 
joint. 

3. The robotic system of claim 2, wherein joints of the 
robotic wrist assembly are actuated by at least one indirect 
drive actuator in a closed-chain, wherein the joint degrees of 
freedom and the actuator degrees of freedom are coupled. 

4. The robotic system of claim 1, wherein the host machine 
is configured to determine a distance of the reference point 
from the boundary when the reference point lies outside of the 
boundary, and to superimpose a velocity component that is 
proportional to the determined distance onto the velocity 
control signals, and wherein the velocity control component 
points back to the boundary. 

5. The robotic system of claim 1, wherein the host machine 
is configured to: 

when the reference point lies outside of the boundary: 
automatically zero a normal velocity component of a 
velocity of the robotic mechanism pointing away 
from the boundary, and superimpose a velocity com- 
ponent pointing toward the boundary, such that the 
reference point is prevented from moving away from 
the boundary while still permitting velocities of the 
robotic mechanism that are tangential to the bound- 
ary; 

when the reference point lies within the boundary but out- 
side of the buffer: 

control the robotic mechanism via the velocity control 
signals without modifying the velocity control sig- 
nals; 

when the reference point lies inside of the boundary within 
the buffer outside of one of the comers, and the reference 
point is approaching the boundary: 
gradually zero a normal component of the velocity 
pointing toward the boundary so as to provide a con- 35 
tinuous transition across the boundary; and 

when the reference point is in one of the comers and is 
approaching the boundary: 

scale down a normal component pointing toward a 
neighboring one of the line segments. 40 

6. The robotic system of claim 1, wherein the respective 
axes are a pitch axis and a yaw axis. 

7. A host machine adapted for use within a robotic system 

having a robotic mechanism responsive to velocity control 
signals, wherein the robotic mechanism has at least two 45 
degrees of freedom and a pennissible workspace defined by a 
convex-polygon boundary having a centroid and defined by 
multiple edges and comer points, and including a defined 
buffer surrounded by the multiple edges, the host machine 
comprising: 50 

a hardware module configured to control an operation of 
the robotic mechanism, and further configured to deter- 
mine a position of a reference point on the robotic 
mechanism with respect to the convex-polygon bound- 
ary; and 55 

a recorded algorithm; 

wherein execution of the recorded algorithm by the hard- 
ware module causes the host machine to: 
determine the position of the reference point with 
respect to the buffer, the comer points, and the edges; 60 
divide the permissible workspace into a plurality of arc 
segments defined by line segments drawn radially- 
outward from the centroid to the comer points; 
enforce the boundary by automatically shaping the 
velocity control signals as a function of the position of 65 
the reference point with respect to the buffer, the 
comer points, and the line segments using an arc 
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segment test, thereby providing a smooth and unper- 
turbed operation of the robotic mechanism along the 
edges and corners of the boundary. 

8. The host machine of claim 7, wherein the host machine 
is configured to determine a distance of the reference point 
from the boundary when the reference point lies outside of the 
boundary, and to superimposing a velocity component onto 
the velocity control signals that points back to the boundary 
and is proportional to the determined distance. 

9. The host machine of claim 7, wherein the execution of 
the recorded algorithm by the hardware module causes the 
host machine to: 

when the reference point lies outside of the boundary: 
automatically zero a normal velocity component of a 
velocity of the robotic mechanism pointing away 
from the boundary, and superimpose a velocity com- 
ponent pointing toward the boundary, such that the 
reference point is prevented from moving away from 
the boundary while still permitting velocities of the 
robotic mechanism that are tangential to the bound- 
ary; 

when the reference point lies within the boundary but out- 
side of the buffer: 

control the robotic mechanism via the velocity control 
signals without modifying the velocity control sig- 
nals; 

when the reference point lies inside of the boundary within 
the buffer outside of one of the corners, and the reference 
point is approaching the boundary: 
gradually zero a normal component of the velocity 
pointing toward the boundary so as to provide a con- 
tinuous transition across the boundary; and 
when the reference point is in one of the corners and is 
approaching the boundary: 

scale down a normal component pointing toward a 
neighboring one of the line segments. 

10. The host machine of claim 7, wherein one dimension of 
the workspace describes the pitch of the robotic mechanism 
and another dimension of the workspace describing the yaw 
of the robotic mechanism. 

1 1 . A method for enforcing a convex-polygon boundary of 
a permissible workspace for a robotic mechanism having at 
least two degrees of freedom, the boundary having a centroid 
and defined by multiple edges and comer points, and includ- 
ing a buffer surrounded by the multiple edges, the method 
comprising: 

determining whether a reference point on the robotic 
mechanism lies within the boundary; 
dividing the permissible workspace into a plurality of arc 
segments defined by line segments drawn radially-out- 
ward from the centroid to the comer points; and 
automatically shaping the velocity control signals as a 
function of the position of the reference point with 
respect to the buffer, the comer points, and the line 
segments, using an arc segment test, thereby providing a 
smooth and unperturbed operation of the robotic mecha- 
nism along the perimeter and within the corners of the 
boundary. 

12. The method of claim 11. further comprising: 
determining a distance of the reference point from the 

boundary when the reference point lies outside of the 
boundary; and 

superimposing a velocity control component onto the 
velocity control signals, via the host machine, such that 
the velocity component points back to the boundary is 
proportional to the distance. 
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13. The method of claim 11, further comprising: 

when the reference point lies outside of the convex -poly- 
gon boundary: 

automatically zeroing a normal component of a velocity 
of the mechanism pointing away from the boundary 5 
and superimposing a velocity component pointing 
toward the boundary, such that the reference point is 
prevented from moving away from the boundary 
while still permitting velocities of the robotic mecha- 
nism that are tangential to the boundary; to 

when the reference point lies within the boundary outside 
of the buffer: 

controlling the mechanism via the velocity control sig- 
nals without modifying the velocity control signals; 
when the reference point lies inside of the boundary within 15 
the buffer, outside of one of the corners, and reference 
point is approaching the boundary: 
gradually zeroing a normal component of the velocity 
pointing toward the boundary so as to provide a con- 
tinuous transition across the boundary; and 20 

when the reference point is in a corner and approaching the 
boundary: 

scaling down a normal component pointing toward a 
neighboring one of the line segments. 

14. The method of claim 11, wherein the two degrees of 25 
freedom are defined by the pitch and yaw axes of the robotic 
mechanism. 



